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ABSTRACT 


Name of student : Giri N.P. Roll No. 88;^0503 

Degree for which submitted : M.Tech : Dept: Mech. Engg. 
Thesis title : "Design and Development of a master slave 

teleoperated robot" 

Names of thesis supervisors : 1. Dr. Amitabha Ghosh, ME 

2. Dr. K. Sriraro, ME/NET 
Month & year of thesis submission : May 1990 

This project involves development of a master- 
slave teleoperated robot which can meet some of the national 
requirements in teleoperator technology and can act as a 
stepping stone in the nascent area of 'telerobotics' .A slave 
robot which can execute possible motions of human arm is 
selected. A kinematically equivalent master arm with good 
hand adaptability is fabricated. Master arm joint parameters 
are sensed with position sensors and ADC. A control software 
which converts ADC output to joint parameters of the slave 
and executes interpolated motion between sampled points was 
developed. The overall system was realised and tests were 
conducted to evaluate the performance. Finally suggestions 
for future extension programmes are made. 
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CHAPTER 1 


INTRODOCTION 


1 . 1 INTRODOCTION 

Teleoperation is the extension of a person's 

manipulative, perceptual and cognitive skills to a remote 
location. The increased need for remote manipulation in 
environments hazardous to human health or survival, like 
nuclear, undersea, outer space, etc has been widely 

recognized. Many tasks in such environments are complex, 
unpredictable and unplanned and therefore cannot be done by 
autonomous machines like robots. Human perception, planning 
and control are required to perform these tasks successfully 

and safely. A teleoperator couples human decision making and 

motor control functions with a manipulator working in a 
remote/hostile environment. 

Teleoperator includes artificial sensors, arms and 
hands , a vehicle for carrying these and communication 
channels to and from the operator 

The manipulator arm and vehicle will be in hostile 
environment and the operator will be in clean environment. 
The manipulator performs its function under direct control of 
the human operator. Fig.l shows the principle of 

teleoperation. The operator moves the hand controller by 
viewing the image of hostile environment & robot on the 



OPERATOR SITE REMOTE SITE 

Disolav 



Fig 1. PRINCIPLE OF TELEOPERATION 
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display. Feed back from visual sensors and -tactile sensors 
on the robot gives him a feel that he is directly present in 
remote/hostile site and thus helps in easy manipulation. 

1.2 CONTROL OF TELEOPERATORS 

Traditionally, the aim of teleoperation has been to 
give the user charge of the movements of remote manipulator 
in an ergonomically satisfactory way. This is done in three 
ways : 

1) mechanical master-slave telemanipulators 

2) powered telemanipulators with unilateral control 

3) Powered telemanipulators with bilateral control 

1.2.1 Mechanical Master Slave Manipulators 

In these, the motions of the operator's hand are 

reproduced by mechanical linkages connecting a slave arm with 
a gripper to a master arm ending in hand control . The 
mechanical connection allows the user to feel the forces on 
the slave and so there is some feedback. Fig. 2 shows the 
principle of cable transmission for 5 dof of such 
manipulator, the sixth being produced by rotating the whole 
system around a sleeve through the wall . 

1.2.2 Unilateral Control 

In unilateral control, there is no force feedback. 
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forwards 
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The operator's control device may take the form of a master 
arm whose joint angles are measured and drive the 
corresponding joint servos in the slave arm. They are used 
wherever mobility is required. A servo for unilateral 
control of one joint is shown in Fig. 3. It is open-loop in 
that there is no feedback from the slave to the master, but 
there is a position feedback within the slave-half of 
the system. In this loop, if the position signal from the 
slave is equal to that from master, there is no motor 
movement . 

1.2.3 Bilateral servo control 

Here the force on the slave arm is fedback to the 
master arm for the operator to feel. Force reflection helps 
the operator to consider himself present in the remote 
location and thus induces 'telepresence'. Systems with 
telepresence are symmetrical where master can also be moved 
like slave just as in the case of mechanical master-slave 
manipulators . 

There are many types of bilateral control systems. 
The master can be designed to take position or force as its 
input, the controlled variable at the slave also being 
position or force and similarly for the return loop. 
Actuators are provided at the master end as well to enable 
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it to be back driven and torque motors generally act as 
transducers of torque. 

At the master and slave ends, position or force 
servos can be used. A position servo (Fig. 4a) maintains the 
output shaft angle equal to the input commanded angle 
regardless of load. A force servo (Fig. 4b) maintains the 
output torque proportional to the commanded torque regardless 
of position. Some torque opposes the torque produced by the 
motor so as to stop the shaft moving. When this is true the 
signal from torque transducers balances the input signal and 
the shaft does not turn. The summing amplifier is required, 
since the motor at master end is back-drivable also and so 
even if there is no error a minimum torque must be kept. In 
other cases types, gears can support the load and motor 
current can be zero. 

There are different types bilateral control 
systems [15] [19]. Fig. 5 shows position-position bilateral 
servo control system. When master arm is moved, the slave 
follows and the operator experiences the forces on the slave, 
though they are not explicitly fedback. 

With these basic control systems teleoperators have 
evolved from mechanical master-slave systems to telerobots. 

1.3 EVOLOTIOH OF TELKOPERATORS 

Teleoperators in the primitive form like 
tools, weapons and cranes which extend human capabilities were 
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being used since eighteenth century. Modern teleoperators 
■.70’"'=' developed in the 1940 's for radioactive material 
handling in "hot cells" . The first teleoperator developed by 
Goertz at Argonne National Laboratory was a mechanical master 
slave manipulator using pantograph mechanisms. Electrical 
servomechanisms soon replaced mechanical linkages. Shortly, 
television helped the operators located far away to view 
remote site. In 1960 's force reflection, two-arm 
teleoperators and head mounted displays produced remarkable 
visual 'telepresence'. Soon teleoperators with video cameras 
were attached to submarines opening up deep sea applications. 
The Sixties also saw the first space manipulator, when 
Surveyor III landed on moon in 1967 and collected soil 
samples. By 1970, industrial robotics was coming into full 
development with computer vision, force sensing etc. Chart 1 
shows the evolution of teleoperators . 

Current developments are mainly in telerobotics 
where supervisory control is exercised by a man over a slave 
robot . 

1.3.1 Telerobotics 

Telerobotics is a relatively new area of 
teleoperator control, made possible by intermingling 
teleoperation with robotics . It is analogous to a supervisor 
monitoring & directing the activities of a subordinate. Here 
the subordinate will be a robot with its own computer. 




Fig 6. CONCEPT OF TELEROBOTICS 
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Supervisory control, though introduced in the 60 's [3] to 
reduce delay in teleoperation, has found application only the 
80 's for advanced teleoperation. It is applied in 
'telerobotics' in which the human operator 'intermittently 
communicates to a computer information about goals, 
constraints, plans, suggestions and orders relative to a 
limited task, getting back information about 
accomplishments, difficulties, concerns and, as requested, 
raw sensory data - while the subordinate telerobot executes 
the task based on the information received from the human 
operator plus its own artificial sensing and intelligence'. 
[ 10 ] 

The human operator supplies largely symbolic 
commands to the computer. However, a fraction of these 
commands must still be analogic ( hand control movements 
etc.) in order to point to objects or to demonstrate to the 
computer relationships that are difficult for the operator to 
put into symbols. Fig. 6 shows the concept of telerobotics. 

The local or human interactive computer thus must 
be human friendly, able to indicate that it understands the 
message or to point out that a specification is incomplete 
and if so help the operator to edit the message correctly. 
It also must interpret signals from the distant telerobot, 
storing and processing them to generate meaningful graphic 
displays. The local computer should have a knowledge base 
and a model of the teleoperator and task environment. The 
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subordinate remote computer which accompanies the tele 
robot, meanwhile must receive commands, translate them and 
perform execution closing each control loop through the 
appropriate telerobot actuators and sensors. 



CHART 1 


Year 

Event 

In,yejit.oxi.,aga.n.s.Y. 

1945 

Mechanical master-slave 

Goertz (Argonne 


manipulator 

National Lab, Chicago 

1954 

Electrical servo manipulator 

Goertz , Thompson 

1954 

manipulator mounted on mobile 

vehicle 

Argonne National Lab. 

1958 

10 dof electro hydraulic 
arm with force reflection 

Mosher (General 
Electric ) 

1961 

Heavy manipulators with large 
capacity (300 kg to 1 ton) 

Jean Vertut 

1963 

Underwater teleoperation 

Cable controlled underwater 
research vehicle . 

U.S. Navy 

1967 

Concept of supervisory control 

Ferrel , Sheridan 

1967 

Surveyor III, Lunakhod 
land in moon and 
collect samples 

USA/USSR 

1969 

Idea of computer-aided 
teleoperation 

Draper 

Laboratory MIT 

1976 

supervisory controlled Viking 
spacecraft with arms to collect 
soil samples from mars. 

NASA 

1970's 

Industrial robotics 

Unimation, Hitachi 
General Electric 

Present 

Telerobotics, teleactuation, 
teletouch, multiperson 
control, supervisory control 

Various 

institutions 
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1.4(CD1BENT APPLICATIONS OF TKLEOPERATORS 
1.4.1 Space 

Teleoperation have been used in space exploration 
for driving vehicle (lunakhod) on the moon and collecting 
soil samples from planetary surface. (Surveyor on the moon 
and Viking on mars). Operation of manipulators on planetary 
surfaces presents the problem of time delay if they are 
controlled from earth. So, it becomes necessary to either 
work slowly or introduce some degree of automatic control. 
Viking arm which sampled soil on mars has been programmed to 
dig and collect samples when moved to a location by 
terrestrial control. 

Current example of space teleoperator is the 20m 
long remote manipulator system (RMS) [10] carried aboard the 
OS space shuttle. It has 6 dof and is controlled directly by 
a human operator viewing through a window or over a video and 
using two, three-axis variable rate command joysticks, one 
for three translations and the other for three rotations,. 
Since operations are performed in zero gravity, the arm can 
be light: It can not support its own weight on earth. In 
space, with low angular rates, it can deploy and retrieve 
satellites of hundred's of kilograms with ease. Master slave 
control is not appropriate at low angular rates. So some 
degree of autonomy is imparted. 
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US space program is focussing on the design of a 
'flight telerobotic servicer' (FTS) , a general purpose 
manipulation device. It is to have two arm of size of human 
arms. Eventually FTS would be attached to a free flying 
thrust platform and also be provided a modicum of computer 
intelligence beyond simple control laws. 

1.4.2 Nuclear power 

Much of the development of teleoperator has been 
stimulated by the need to handle radio active materials 
Nuclear 'hot' laboratories continues to use the maximum 
number of teleoperators. Most extensive & successful of such 
systems are MA - 23 type designed by Vertut and Master-slave 
type designed by Goertz . They use mechanical master slave 
system with transmission passing through the wall separating 
master's clean room from 'hot cell'. Operator watches slave 
operations through a radiation opaque window or a video. 
They are widely used in radio chemistry or isotope 
applications, spent fuel handling and reprocessing. They had 
to be designed to remain inside radio active nuclear fuel 
processing enclosures for many months and thus be extremely 
reliable. Nuclear teleoperators are now becoming 
sufficiently mobile and dexterous for doing tube repair work 
on steam boilers, plant maintanence and, decommissioning and 
decontamination of reactors. Recently, nuclear engineered 
advanced telerobots (NEATER) are introduced in some nuclear 
installations in UK [16]. They have converted PUMA 762 
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produced by Unimation Ltd. into a telerobot, after improving 
seals, circuitry etc to prevent irradiation effects and plan 
tc use them for decommissioning & nuclear waste management, 
(also see 1.5) 

1.4.3 Deep sea 

Offshore oil and gas industries use remotely 
operated submersible vehicles in well head completion 
operations, monitoring of pipe lines and inspection of welds. 
These applications were initiated by cost and risk factors 
involved in such operations . Most undersea manipulators are 
hydraulic to withstand high forces. They are usually 
tethered to a mother ship and are manned or unmanned . 
Remotely operated vehicles are also employed to aid 
scientific investigations by marine biologists and 
geologists, and for mineral module collection from sea bed. 
Argo and Jason Junior are such unmanned submersibles used in 
1987 expedition to the 'titanic' [10]. 

1.4.4 Medical 

Medical field employs many arm prostheses which 
include digital processing of myoelectric signals and modern 
mechanical actuators, augmented by natural looking hands. 
Teleoperated electro mechanical guide dogs have been 
developed to guide the blind. 
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One form of teloperator used in surgery is the 
endoscope [6], a coherent fibre optic bundle with tubes for 
ccn'^'eying fluids, a gripper at the end for minor gripping and 
surgery . 


Teleoperators are also widely used in terrestrial 
mining, construction and roaintanence, firefighting, 
surveillance and military operations. 

1 . 5 INDIAN SCENARIO 

Indian nuclear research programme have been using 
various remotely operated' mechanisms' such as fuel handling 
machine for on line fuelling of reactors, retrieval system of 
irradiated fuel clusters, decladding machines, device for 
handling fuel, isotopes and guidetube assemblies, remote 
cutting facilities etc. Manipulators employed in nuclear 
sector have been of mechanical master-slave type which are 
descendants of Goerts machines. Recently, work has begun on 
the use of electric servomanpulators and robots for fuel 
decladding and spent fuel reprocessing. Some robots are 
employed in online sampling of processing. Ramakumar & 
associates describe various remote handling systems used in 
nuclear installations in [1]. 

The trend in nuclear sector is towards teleoperated 
mobile robots which will enhance applications in current 
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nuclear research and decommissioning of spent rectors. 

Space research also plans to use teleoperators in 
its ground based systems [1] . These include teleoperated 
arms for assembling and testing explosive devices, mobile 
units with teleoperated arm for launch pad inspection and, 
assembly robot to build space structures . 

1.6 OBJECTIVE OF PRESENT WORK 

The mechanical master-slave manipulators being used 
in Indian nuclear sector have many disadvantages. Because of 
length limitations it must be in a fixed position relative to 
the master. This restricts the use of these manipulators to 
manipulation in fixed installations. In future, requirements 
of mobile electric servomanipulators will be more to meet 
wide ranging applications in nuclear research and nuclear 
power plants, and in decommissioning of reactors like 
Tarapur in the near future . Some beginning has been made in 
electric servo manipulation, but yet in nascent stage only. 

'Telerobotics' is the state of art area in 
teleoperators, where major research works are being carried 
out abroad. In India, telerobotics research has not started 
yet. So to meet the national requirements in teleoperator 
tehnology and to establish a beginning in 'telerobotics', 
the idea of master slave teleoperated robot was conceived. 
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1.7 SCOPE OF PRESENT WORK 

The scope of present work is to develop a PC based 
master-slave teleoperated robot with position information fed 
to the slave robot by master arm controlled by an operator 
with less skills. It involves the design and realization of 
a master arm with good human interface, selection of the 
slave robot which has sufficient dof to execute arm 
controlled motions and development of a control software to 
achieve teleoperation. Later, mobility, telepresence by 
force reflection and supervisory control can be incorporated 
as future extension programme. The details of developing such 
a system is discussed in this work. 

Chapter 2 covers details of master slave system 
requirements, slave robot and its selection criteria. The 
master arm design is discussed in chapter 3 . Chapter 4 
describes control software and electronic mddules used for 
teleoperation. Performance of the developed system is given 
in chapter 5 . Suggestions for future work are made in 


chapter 6 . 



CHAPTER 2 


MASTER-SLAVE TELEOPERATED ROBOT SYSTEM 

The system consists of a master arm, slave robot 
and controller, and computer. The master arm positions are 
supplied to the slave robot by position sensing and through 
the computer. The computer communicates with the robot 
controller regarding information from master and the 
controller performs robot actions using local loop. Thus it 
encompasses electric serve controlled teleoperation and 
'telerobotics' . 

2 . 1 REQUIREMENTS 

In master- slave teleoperated systems, since man is 
included in the control loop, attention has to be paid in 
designing man machine interfaces and in selecting the slave 
robot. Since the objective of the present work is 
development of PC based master-slave system controlled by 
less skillful operator, use of advanced controllers [11] is 
not considered because of two reasons: one, operator skill 
requirements are high; two, they involve large computational 
facility for direct kinematics of master arm, inverse 
kinematics of slave arm and interpolations . So master arm 
has to be kinematically equivalent to the slave arm and both 
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roaster and slave roust be able to execute almost all possible 
motions of human arm and wrist. 

With 6 dof, a manipulator can imitate human arm 
motions of shoulder (3 dof- roll redundant with elbow roll) 
elbow (2) and wrist (2) and thus locate and orient an object 
in space. With three major joints, shoulder and elbow 
movement can be duplicated. Human wrist has following limits 
to its three motions [4] (Fig. 7) 


pitch 

-90 *■* 0 

+50 

= 140l 

, elipocJ not axWWL 

yaw 

-45 u 

+45 

= 90 J 


roll 

-180 0 

"»-*+90 

= 270 

(elbow extended) 


-180 <*p*0 

♦-+ +5 

= 185 (elbow not 

extended) 


Another aim of the project was to mark a beginning in 
telerobotics where the slave has some degree of autonomy and 
hence must be a robot. With these requirements. the 
specifications of slave robot were generated. 

SpecilicAtiana. ai s.I ay .£. rabat = 

degrees of freedom : 6 (wrist satisfying limits 

given above) 

Joints : Electric servomotor controlled 

with position feed back 


min reach 


500 mm 
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Payload capacity 

interfaces 

Accuracy 


1 kg 

PC compatible 
± 2mm 


programming options : point to point and continuous 

path. 


Emergency stop provision 


A detailed tender evaluation of various educational 
robots were held and MA 2000 supplied by Tec Quipment 
International Ltd., UK was found to meet most of the 
requirements . 

2.2 SLAVE ROBOT - MA 2000 [12,13] 


MA 2000 consists of a robot arm, electronic 
controller, teach keypad and software. Robot arm has six 
d.c. motor powered revolute joints operating with closed loop 
control. It also has a pneumatic gripper. The 
specifications of the robot are shown in appendix 1 . MA 2000 
is shown in Fig. 8. 

MA 2000 operates with IBM compatible host computer. 
The keypad is used to communicate with the computer and 
controller. It has additional input /output ports for 
controlling other devices. The robot is programmable upto 
100 steps of joint position data. It has following 
programming options . 




***9 o. MA-eooo Slave robot ng 9. ma zooo Joint motion limits 
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lead by nose - continuous path 
lead by nose - point to point 
teach keypad - point to point 
offline computer programming 

In all the above options it works on teach and 
playback mode. Each step has information regarding step 
number, rate of movement (0-9 discrete), input, output, wait 
(time in second), jump (to a certain step), the joint 

parameters for waist, shoulder, elbow, pitch, yaw &'roll and 
gripper status (close/open). All joints are allotted 
micromotion steps is the range 0-999, within their limits of 
motion. The limitation of joint motion is shown in Fig 9. 

Only one of the taught steps can be of lead by nose 

continuous path mode: 

2.2.1 Robot controller [ 13] 

The controller of MA200 consists of a combined 
interface and motor controller board. It is designed to be 
driven from the host computer which supplies position 

information for each of the robot joints; the controller will 
then supply PID digital servo control of upto 6 channels to 
control the robot axes to achieve the required joint 
positions . 


Motor controller uses a 6502 CPU operating at IMHz 
clock rate. It's prime task is to perform a real time PID 
control. It also communicates with the host computer to 




Hechamcal 

Linkage 


Fig 1 0. ISymtmm cionfigur«tion - MA SOOO 


(Courtesy |3]) 
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obtain position information and interrogate the front panel 
controls. The system block diagram is shown in Fig. 10. 

2.2.3 The host computer 

The main task of host computer is to interpret the 
user's requirements and translate them to a series of motion 
set point commands and send them to motor controller 
interface. It also 

scans the teach keypad 
sets pneumatic gripper 

read status of the controller front panel 
instruct the controller interface CPU to report 
joint position, errors and motor power. 

The operating software for the motor controller is 
held is ROM. Areas of RAM are used as a workspace and as a 
shared memory, (i.e. motor controller and computer can access 
this area). Four of the latches and 128 bytes of RAM (shared 
memory) are accessible to the host computer; the rest of the 
interface is not available to computer, but control 
information can be relayed to motor controller through shared 
memory. 128 bytes of shared memory are resident at addresses 
0 to 7F hex. Two read only latches at addresses 80 and 81 
hex and two write only latches at addresses 80 and 81 hex are 
used for process inputs and outputs and for keypad and front 
panel controls . 



2.2.3 


MA 2000 - IBM interface 


The unit allows IBM compatible host computer to 
communicate with the shared memory in robot controller and 
with two sets of read' write latches. It uses 8255 
programmable peripheral interface and associated circuitry to 
accomplish this. 8255 has three ports A, B, and C which can 
be programmed to input and output 8 bit data. The address in 
shared memory is allocated to port A. The data transfer to 
the shared memory is through port B and READ/WRITE and ENABLE 
signals are allocated to port C bits 1 and 0 respectively. 
The base address of interface set to 300 hex. 



CHAPTER 3 


MASTER ARM 

SEoploying the robot in the teleoperator mode 
requires the design of a man machine interface with primary 
controls achieved through the use of hand controls. It must 
have 6 dof so that 6 axis slave manipulator, commanded by 
displacements in tht? hand controller can be located at any 
point in workspace and be oriented at any desired attitude 
angle. The operator with less skill must be able to generate 
input commands of more than one axis with minimum or no 
unintended movements in other axes with one hand only. These 
were the prime considerations in designing the master arm. 
The master arm is designed kinematically equivalent to the 
slave arm. 

3.1 DESIGN 6DIDELINES 

Master arm was designed to meet functional 
requirements of kinematic equivalence, sensor accommodation 
and human interaction. The wrist and grippers are designed 
to furnish almost all possible motions of human arm without 
fatigue. The arm has to be operated single handedly. Hence 
weight acting on arm (effective weight) influenced the 
design of master arm. Based on ergonomic charts[23 the 
effective arm weight was fixed to be less than 0 . 5 kg and to 



Fig 11. MASTER ARM 
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meet this, it was decided to use aluminium alloy as material 
and to add counterweight/springs at the joints to balance 
the weight. Wrists and gripper were designed to execute 
possible motion of human hand, without any interference. 

3.2 LINKS AND JOINTS 

All joints are provided with roller/ball bearings 
for smooth motion. The base link is made of cast iron block 
held on supports. Shoulder link is made of cast aluminium 
block Other links are made from 3mm thick Aluminium alloy 
sheet. The fabricated master arm is shown in Fig. 11. 

Two taper roller bearings are used for base shaft 
foreseeing the future need to mount the master arm on the 
ceiling for better adaptability to hand motions. The shaft 
end is extended so that shoulder link can be rigidly 
connected to it by grub screws. Other joints have simple 
ball bearings. The transmission of motion from shaft to 
succeeding link is by grub screws which tighten the shaft 
with a collar rigidly connected to the link. The joint 

shown in Fig. 12, 13, 14, 15. 


cross sections are 




Fig.\2 BASE JOINT ASSEMBLY 


1, Base joint shaft 

2, Bearing housing 

3, Collar 

4, Link 0 Cl block 


6. Pulleys 

7. Potentiometer 

8. Taper roller bearing 

9. Shouloer (link 1) 


5, i\asher 


10. Support 


I 20 



Fig.l3 SHOULDER JOINT ASSEMBLY 


1. Shoul.-.er link C 

2. Collar 

3. Bearing 

4. Circlip 

5. end cover 


6. Collar 

7. link 2 channel 

A1 60 X 40 x3 

8. Pulley 

9. Potentiometer 

10. Shoulder joint shaft 





Fig.14 ELBOW JOINT ASSEMBLY 

1. Collar 5. Pulley 

2. Bearing housing link 2.60 x 4C x 3 

3« joint shaft 
4, Potentiometer 


7, link 3 taper channel 



^ Fig.l5. PITCH, YAW a ROLL JOINT ASSEMBLY 


1. link 3 taper channel 

2. Potentiometer 

3. Bearing 

4. Pulley 

5. Joint 4 shaft 
Joint 5 shaft 


7, Collar 

8, Support 

9, link 4 channel 32 x 30 x 3 

10. link 5 channel 40 x 30 x 3 

11. Gripper (link 6) 

12. Bearing housing 


6 . 
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3 . 3 GRIPPER 

Gripper and wrist design stressed on compactness, 
mechanical stiffness and dexterity. Gripper (Fig. 16 )is made 
to accommodate left wrist and fingers of man. Thumb is fixed 
to the gripper to transfer the wrist motions while the fore 
fingers are inserted into a block hinging at one end. The 
distance between thumb and other fingers, which varies among 
people, can be adjusted to give effective working envelope 
for hand. The hinged block is spring loaded for return 
action and counter balancing. The gripper is also provided 
with a sliding switch to operate the slave gripper. 

3.4 SENSORS AND TRANSMISSION 

Potentiometers are chosen as position sensors in 
master arm due to their reliability in continuous operation 
and easy availability. Base and shoulder joints use three 
turn potentiometers and others single turn . They are driven 
from corresponding joint shafts by belt and pulley mechanism 
with suitable speed ratio such that the potentiometer range 
is fully utilized. For example a 270*^ potentiometer used to 
sense joint with 180® limits of motion is driven by pulley 


of speed ratio 3 '•2. 



Fig.ie- gripper (MASTER ARM 
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3.5 MECHANICAL STOPS 

The slave robot has limit switches at all joints 
and hence can execute only less than one revolution at 
joints . Mechanical stops are provided in the corresponding 
master arm joints so that all motions made by operator at 
master arm end are within permissible limits and hence 
executable at the slave end. 



CHAPTER 4 


CONTROL 


4.1 PRINCIPLE 

After analyzing the MA2000 robot system, it was 
found that it can be converted to a teleoperated robot by 
making changes such as freeing the robot from keypad 
interaction, elimination of lead by nose in continuous path 
mode and repetitive refreshing of memory to receive new data. 
In lead by nose- continuous path mode, during teaching the 
host computer gets position information at sampled intervals 
supplied by position sensors of the robot through the motor 
controller interface. The whole continuous path information 
is stored in host computer's memory as an array starting from 
specific location and is treated as a single step while play 
back. The robot allows only one step of continuous path in 
the sequence of taught steps to be played back. While play 
back, these data points are transferred to the motor 
controller and the controller executes interpolated motion 
between sampled points so that the taught path is traced. 

So, if master arm joint parameters after suitable 
calibration can be stored as set points in the computer 
memory and the assembly language routine executing 
interpolated motion can be called, the slave robot can be 
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moved after a small delay, through the path traced by master 
arm. If this procedure is repeated infinitely updating joint 
parameters and calling routine for continuous path motion, 
the teleoperated robot can be realized. 

4 . 2 ELECTRONIC MODULES 

A +5V supply is connected across the potentiometers 
of master arm. The intermediate points of the potentiometer 
are connected to a standard ADC card PCL712 [18]. 
Specifications of the card are given in appendix (2). The 
potential between ground and intermediate point of the joint 
potentiometer will indicate corresponding joint positions of 
the master. ADC card can be programmed to read input 
voltages. The MA2000-IBM interface card is used to 
communicate with the controller of the robot . The host 
computer used was HCL Busybee PC-AT (IBM compatible) in 
Robotics lab, IIT Kanpur. The master— slave interface is 
shown in Fig. 17 

4.3 CONTROL SOFTWARE: 

An interactive and user friendly software was 
written in BBC BASIC to control the teleoperated robot. The 
source code listing is given in appendix (4) and instructions 
to use the system in appendix (3). 



Fig 17. Master. Slave Interface 
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The software initialises by setting up hardware 
addresses and links between BASIC variables and assembly 
language routines. It then sets up 8255 into port A output, 
port B put and reads latch B to know the status of 
controller by sending read enable by setting bit 0 of C port 
to 1. If communication between controller and computer is 
perfect, it moves the robot to park position which is the 
usual position of the master arm when not used. The movement 
is achieved by calling CALSISA and SAMOVE assembly language 
routines. Robot is now ready to act as teleoperator. 

Calibration parameters are setup (ref. 4. 5) which 
converts the signals from potentiometers at master arm joints 
into corresponding slave joint parameters. ADC input 
channels are read and input voltage measured. They are 
converted to first set point. Like this, four set points are 
stored in memory locations accessible to assembly language 
routine CONTPATH which executes interpolated motion between 
these points . The memory refreshed and new sets of points 
are stored and CONTPATH is called again. This procedure is 
repeated infinitely. The flow chart for control software in 
shown Fig. 18 . 

4.4. ERROR ELIMINATION 

While testing the system, it was found that slave 
arm produced some chattering motion due to input errors . 
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This was found to be of the order of +8 steps at each joint 
A threshold of ± 10 was setup to prevent chattering motion 
and was incorporated in the software . 

4.5. CALIBRATION: 

Each joint of slave robot can move in the 'range of 
microsteps from 0 - 999 in their limits of motion. Any 
joint position can be read as a step number by running the 
software supplied by the manufacturer. 

A reference configuration common to master and 
slave is chosen, (see Fig. 19). With this, for each joint a 
reference position with respect to the previous joint was 
fixed and corresponding step number noted (No). Then the 
joint is rotated through a specific angle and the new step 
number noted (N) . The difference n = N ~ Nq found. 

Each of the master arm joint is brought to the same 
reference position as the slave robot joint. After noting 
the value of the potentiometer at the joint (Rt)> “the 
potentiometer alone is turned so that it achieves a position 
permitting motion in the safe range, and resistance (Ro) 
between ground and intermediate point noted . The master arm 
joint after ensuring transmission of motion from joint shaft 
to potentiometer, is rotated through the same angle as 



Fig.l9. REFERENCE CONFIGURATION FOR CALIBRATION 

Resistance (steps) [ voltages for ADC.C Program] 
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corresponding slave arrn joint and new resistance reading 
noted (Hi) and the difference r = - Rq is found. While 
turning the master arm joints care has been taken to ensure 
that the same sense of rotation produce similar variations in 
steps and resistance. This procedure is repeated for all the 
joints . 


If a known input voltage is applied across the 
potentiometers (Vin) and at any intermediate position, ADC 
shows a voltage V at corresponding channel, then the joint 
step number (N) can be found from 

N = No + n jy - (Ro/ Rt) Vin 

h 

(r/ Rt) Vin 

Later a program was developed to calibrate the system by 
bringing master arm to the reference position and noting the 
voltages directly ( see appendix 3) . 



CHAPTER 5 


PERFORMANCE OF THE SYSTEM 

The master arm hardware was realized in IIT 
facilities. It was found to give human arm accommodation and 
manoeuvrability. Position sensors were connected to the 
joints and associated circuitry made. The standard ADC card 
used, initially gave multiplexing problems due to incorrect 
resistances used at the production level. The problem was 
eliminated by replacing with correct resistances. The 
control software developed was trial tested. The master 
slave interfaces made and the system was successfully tested 
with control software developed. The overall system as shown 
in Fig. 20. 


The software was found to be user friendly and it 
made the robot work independent of keypad which was 
previously essential for robot operations with manufacturer 
supplied software. The software gives good interaction by 
giving proper suggestions and warnings . 


Tests were carried out with the operator 
manipulating objects by looking at video image of slave 
robot (Fig. 21). Simple manipulations were easy; but slightly 



Fig 20. Master- Slave Teleopera ted Robot 
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complex operations were found to be difficult, though not 
impossible, mainly due to inability for depth perception in 
TV screen. 


Tests were also performed to find response and 
accuracy of master slave system. The master arm gripper was 
given movement in x,y,z directions and corresponding 
movements of slave arm gripper was measured with respect to a 
parallel coordinate frame. Results were plotted as shown in 
Fig. 22. 


The error in movement of the slave arm are 
contributed by following factors: 

The master arm was designed to be kinematically 
equivalent to the slave robot; but the fabrication errors 
have disturbed this equivalence. Fabrication errors in link 
dimensions will produce accumulated error in end effector 
movement . 


There were errors in calibration since the instruments 
used to measure angle were not very sensitive. This can 
cause errors because of lack of correspondence in joint 
motions . 

The standard ADC used was found to give fluctuations in 
voltage probably due to noise in environment or imperfect 




ri& 21. TeIeof>erated Robot- Tests with videos 
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ps in every joint, and a threshold was setup in software 
to eliminate it. This threshold can cause error in end 
effector position, by not being able to respond to micro 


movements . 

There were inaccuracies in setting up parallel 
coordinate frames. This caused measurement errors. 

The potentiometers used at master joint were not of very 
high quality. They can give rise to variable contact 
potential and non linearity over mechanical range or non 
linearity due to thermal variations. 

Even with threshold setting in the software, the 
slave was seldom found to give erratic movements of 
approximately 15*^ at the base and shoulder joints. Tests were 
carried out to detect the source of error.lt was found that 
ADC gave rise to errors of +10 steps and with potentiometer 
connected errors went upto +40 steps. These can be reduced by 
filtering signals at the input to ADC and shielding of 
cables . 


There was time delay in the response of the slave 
for motion executions. This can be attributed mainly to BBC 
Basic compilation, interpolation routines, and inherent 
delays in motor controller feedback loop and motor response. 
With the continues path mode^ it was not possible to control 
gripper with software . Later ^ a program was written using 
offline mode to get gripper control through software. Because 
of offline nature,, response of the slave was slow and it moved 
in point to point manner. It can be used for pick and place 

CEMT9''i, t !^RARY 

operations . ! ' ' ‘ 


Since visual 


feed back was used 


in deciding the 


course of action for the slave robotj, these errors and delays 
did not cause much problem during manipulation. 



CHAPTEB 6 


CONCLDSION 

With the limitations in fabrication and 
instrumentation, the master- slave robot system performed 
well . With appropriate modifications it is hoped that it can 
meet the requirements of Indian nuclear, space and industrial 
sector and act as a stepping stone in the nascent area of 
'telerobotics'. It can initiate variety of future projects. 

6.1 SOGGESTIONS FOB FOTOEE WOBK 

The errors in slave motion can be reduced to a 
considerable extent by using a in-house developed dedicated 
ADC, better positions sensors like optical encoders, and 
shielding the cables. 

The error and sensitivity analysis of the 
teleoperators system is a problem to be studied and tackled 
for using teleoperator in complex and micro task environment. 

The teleoperator can form part of a mobile 
inspection/assembly system by mounting the slave arm on a 
joystick controlled mobile platform having a teleoperated 
camera and lighting system. These mobile units will be more 
versatile than mobile Robot units available in foreign market 
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due to teleopera ted nature of arm. The mobile unit can be 
equipped with its own transmitter and receiver and thus the 
cable limiting the mobility can be discarded with. Such 
systems can be operated from remote locations . 

The slave arm can be fitted with force sensors and 
master arm with actuators so that the operator gets force 
feedback and hence can perform complex operation. These 
systems can act as catalysts for works in the area of 
'telepresence' . 

Ergonomic studies can be carried out to study the 
operator fatigue and skill which will turn out data useful 
for many applications. 

With better computational facilities and 
processors, the master arm can be replaced with a small 
joystick. which, though increases skill requirement of 
operator, will greatly reduce arm movements and the resultant 

fatigue . 


PC compatibility of the developed master - slave 
system and use of robot as slave can open the new area of 
-telerobotios-. which is the human supervision of 
semiautonomous systems. The human operator provides largely 
symbolic commands to the computer regarding goals. 
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constraints, contingencies and assumptions while the 
subordinate telerobot executes the task based as information 
based on information received from the human operator plus 
its own artificial sensing and intelligence. The 
elimination/reduction of time delay in teleoperators loops is 
a research topic. Supervisory control was suggested as 
remedy^ in which human operator interacts with the computer 
over the delayed channel and let the computer implement the 
commands unimpeded by the loop delay . Studies can be 
undertaken to implement supervisory control in the present 
system. As a beginning, during continuous path 
teleoperation, the robot can be stopped at a certain location 
and directed to execute a preprogrammed sequence of steps 
imparting some autonomy to the teleoperator. 
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Appendix 1- 2000 specif icati nn.-:; 


ItW: 


CHANiSM 

Configuration A levolute arm with 3 major 
and 3 wrist axes. 

Major axes Waist, shoulder and elbow 
rtioving through 270® at maximum slew rate of 
45° per second. 

Wrist axes Pitch, yaw and roll moving 
through 180° at maximum slew rate of 90° per 
second. 

Gripper Pneumatically powered gripper 
attached to roll axis (a separate air sutmly is 
reqitlred|. 

Arm velocity 9 programmable speeds: 
maximum 400mm per second. 

Reach Nominally 500mm with jaws supplied 
In experiment kit. 

Load capacity tkg dead lift at 480mm from 
waist axis. 

Drive system Electric: dx. servo motors under 
closed-loop, 3-term control, with direct 

S >sltlon feedback on each axis measured to 12 
t resolution. 

Resolution t part In 1000 over angular span 
on each axis. 

Repeatability ± 2mm. 

Accuracy ± 3mm. 

Joint pbsitlon transducers Plastic film 
potentiometer with linearity of ±0.25%. 
Sensor Supply Arm prewired to accept 
microswitch or optical sensors at the gripper. 

Controller liMTERFAce 

^Unctions Interface to hos^ computer. AID 
converter. 

IVticrotsrocessor implementing 3 term control. 
IWTotor drive circuits. . 

t/O ports 2 outputs, each a relay contact pair 
switching t A at 24 v dx. 

4 Inputs, each operating on corinectlori td 
darth (ground) potential, 
ialety Emergency stop button, 'Watch dog" 
timer and window detector circuits. 

Motor braking relay provides tall safe to "Set" 
;Of major axis movements on Interruption of 
power Supply. 

Main bEERAtING SoHuarE 

Kiumber of sfefts Up fo ido tauglif steps in 
bdint-to-point operation, or one block of 
continuous path data can be memorised, 
if ep com iftands I’ositlon, speed, mode or 
hriovement I/O port state wait time and branch 
br jump instruction. 

Modes of movement {available at dach step) 
Wo movement; control commands only. 

- Move to absolute position. 

Move relative to last positlori. 

- iearrh for Input. 

- Search and learrt. 

- tUntlnbouipath. 

- branch to User Written BASlC subroutines. 

- Peporl back bn positional errors, actual 
position of motor powers. . , ^ * 

Tutor program A 3d step Interactive leach- 
^ndJearn seguence to familiarise UserS with 
'thd Systerd. 

libit taMNUfifi 

AedfH liBt Model 8 Ihiciticdmputef tdmtjlefe 
With Vided monitor (IVIAlOO) Or O U MEKtOlf 
thlcrDCbmjjti ter (M A1 to). 

Ktofe: Eor tbnttnUdUi |jath btjeratlori ' 
.SdditioHal memory It mguirM for thfe bbC . • 
Mddel B mlch>cttmt)Utfeh 
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Appendix 2 

AX iCL 712 SPECIFICATIOl^S 

Analog to digital 

Input Range : Bipolar +/-5V 
Input Channels : 16 single ended 
Accuracy : +/-0.2% at +/-5V range 

+/-0.3% at +/-1V range 
Input Impedance: > 10 mega Ohms 
Conversion time: < 30 microseconds 
Resolution : 12 bits 

Digital to analog 

Output Range : OV to 5V 
Output Channels-: 2 

Accuracy : 0.1% 

Settling time : < 30 microseconds 

Eor 5V step 

Resolution : 12 bits 

Digital Input 

Input Low Level ; Min. -0.5V, max. 0.8V 
Input High Level: Min. 2.0V, max. 5.0V 
Input Loading : 0.2 mA at 0.4V 
Input Hysteresis: Typical 0.4V, 

min. 0.2V 

Digital Output 

Output Low Level : Max. 0.5V at 8 inA 

(sink) Max. 0.4V at 4 in A 

Output Higli Level: Min. 2.7V at 0.4 mA 

(source) 


Power Consumption 


< 800 mA at 5V 

< 50 mA at -^1 2V 

< 50 mA at -12V 


General ^ ^ 3 3 / 4 - 

Dimensions * 34 cm x 9.5 cm 

„ ; IBM PC bus 

: One 62-pin slot 

I/O Port Base 200 _ hex 3F0 

: 12 


I/O Port Space 
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Appendix 3 

Dsers manual for master-slave 
teleoperated robot 
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1. Calibrate the roaster arm (ref Fig. 19) 

a . ensure that 

- all motion transmission screws are tightened 

- all potentiometer contacts are correct 

- no belt slipping during motion 

b. Connect a +5V supply across the potentiometers 

c . Connect the joint potentiometers to corresponding 
channels . 

d . Run the turbo C program ADC . C to measure input 
voltages . 

e. Bring the master arm joints to reference position. 
Turn the potentiometer alone so that the voltage 
read +0.06V of that given in square brackets. 


NB; (i) If you have changed any of the potentiometers, 
proceed as follows 

a: calibrate the system again as per 4.5 

b: change variable, (Vj)i and (Pj)i in lines570 to4^0 

of 'TELPATH' program 
(Pj)i = (No - n * Ro/r)i 
(Vj)i = (n Bt /(r * Vin)i 
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where Vin input voltage while running the robot in 
teleoperator mode. 

f 

(ii) Default setting of Vin is + 5V. If you have to change 
it (but always < 5V) change Vin in line no 370 of the 
program 

2 . Isleoperator is. ready ta function 

CDXBBCBAS 
BBCBASIC 

> LOAD "TELPATH" 

> RUN 

Ensure that controller is connected and is in 
AUTO mode. In case of any problem following massages will be 
shown 

mess-age. remedy 

Controller status invalid : Check that controller is 'on' 

and communication in good. Re run the program 
Controller not in auto Press <reset> <auto> of 

controller . 

Press P to park the robot 

type M for teleoperator mode 

- press 'M' key 

* now the slave is ready to work as teleoperator 

* IN CASE OF ANY INVOLUNTARY MOVEMENT OF THE ROBOT PRESS 
EMERGENCY STOP IN THE CONTROLLER TO STOP THE ROBOT. 
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If the involuntary motion is not serious press <reset> 

button to continue working as teleoperator 

If the movement seems to be hazardous escape from the 
program pressing <esc> in keyboard. THEN AND THEN ONLY, reset 
the controller. 

NB: If the robot was driven out of limits adopt following 

procedure to bring within limit - Press the <reset> and 
<test> button together. 

Keep <test> pressed and select the joint to be brought 
to limits and move it using front panel control. 



APPENDIX 4 


SOURCE CODE LISTING 


1 0 DATASTOPOSCLIOSCLIOSCLIOSCLIi^#.#' 

20 HIMEM=acA 000 :AA%=&F 600 ;FF«=PAGE 

50 I$="5A.05” 

40 REM COPYRIGHT (C> 1990 I IT KANPUR 

50 5>%=2 : VDU26 :CLS;PRINT’ " TELEOPERATOR PROJECT” ' TAB( 8 > " 1 1 T 

Kanpur” ’ ’TAB< 12) • ”Copyright (C> 1990 IIT KANPUR"’’ 

60 : 

70 REM Author; N.P.Giri, IIT Kanpur 
80 ; 

90 N%=6 
100 0«=T0P 

110 PROCi ni t lai tPROCmcode 
120 PROCcheckseq 

150 PROCcheckmc; IF stop VDUl 1 . 1 1 . 1 1 :REPEAT PROCcheckmc; 

UNTIL NOTstop 

140 FOR a%=0TO2:PROCout(a«.0) :NEXT:PROCpark 
150 IF CC*=0 ENDPROC ELSE mode%=6 
160 PROCcalib 
170 VP^=VPOS: I*=VP*+5 

180 sa*<l > = 500;sa%(2) = 858;sa%<5) = 160:sa%;<4> = 999: 
sa*<5>=500:sa%<6>=0;sa%(0>=0 

190 FOR I%=1 TO 6;err«<I*)=sa«(I*):SPD*(I«)=sa%<I%>:NEXT 1% 

200 PRINT;PRINT"Type ’M’ for TELEOPERATOR mode” 

210 REPEAT UNTIL GET$="M" 

220 PRINT:PRINT"TELEOPERATOR IN ACT ION” : PR INT : 

PRINT"To STOP press <esc>" 

250 REPEAT 

240 PROCcheckmc 

250 ptr*=CC*: J«=BB*-2*bytes« 

260 FOR COUNTl= 1 TO 4 ; PROCget te 1 e ; PROCsca 1 e < 1 , 6 > 

270 FORM%=lTON%: ?ptr«=SA«<M%>MOD256 :ptr*'?l=SA«<M^>DIV256 ; 

ptr«=ptr*+2;NEXT 
280 NEXT 

290 PROCstatus<0> : Z%= <ptr«-CC«> / ( 2*N%) ; PROCspeed ; PROCcontpath 
500 PROCgr ip<sa^<0) ) :FOR I«=l TO 6 ; SPD%< ) =sa%( 1%) ; NEXT 1% 

510 UNTIL FALSE 
520 END 
550 === 

540 : 

550 DEF PROCcalib 
560 REM ============= 

570 vin=5 .0 :pj 1=558*0.498/(0 . 1 12*vin> ; v j 1=500-558*0 .25/0.11 

580 p j 2 = 558 * 0 .201/(0 .046*v in) ;v j 2=500-558*0 . 1/0.046 

590 p)5=540*0.97/(0.55*vin) ;v j 5=160-540*0 . 54/0.55 

400 pj 4=500*1 . 082/(0 . 510*v in):vj4=500-500*0.6/0.510 

410 pj 5 = 500*0 . 956/(0 . 2 57*v in) ; v j 5 = 500-500*0 .5/0.257 

420 pj 6 = 500*1 . 009/(0 . 520*vin) : v j6 = - 500*0 .080/0.520 

450 ENDPROC 



440 DEF PROCspeed 


450 REM = = = = = =: = = =: 

460 R%=1 

111 ^^'^^;^:"';;J=^®2isa%(R«)-SPD%(R^>);Rtfe=R^+l:UNTIL R%>6 OR mx%>50 

480 IF R%>6 OR <mx%>50 AND mx%<100> rate'*=7 : ENDPROC 

490 IF <mx^> = 100 AND mx%<150> rate5K=8 : ENDPROC 

500 IF mx%>=150 rate%=9 : ENDPROC 

510 DEF PROCwbus(a«.d%) 

520 REM ======== 

550 PUT b%+3,156:PUT b%,a%:PUT b*+l.d%;PUT b^+5,l:PUT 
b%+5,0:PUT b^+?,138:PUT b^+3 , ? ; ENDPROC 


540 : 

550 DEF FNrbus<a^> 

560 REM ====== 

570 LOCAL d%:PUT b«.a%:PUT b«+5 , 1 :d*=GET<b%+l > .-PUT b«+5.0: = d^ 
580 : 


590 DEF PROCpeek(s%) 

600 REM ======== 

610 IF s%<0 ENDPROC ELSE ptr*=DD?K+by tes%*s* 

620 rate%=’>ptT*:mode*=ptr«?l : input%=ptr%'’2 output*=ptr%'?5 : 

wai t%=ptr^‘>4 : jump?K=ptr^'>5 
630 IF jump%=255 jump*=-l 
640 IF input%>127 i nput%=l 27- inputs 
650 IF output^>127 output^=127-output% 

660 ptr%=ptr«+6 :FORM^=0TON%:sa«(M*>='?ptr«+256»ptr%'>l : 

ptr^=ptr%-»-2 :NEXT 
670 ENDPROC 
680 : 

690 DEF PROCpoke<s%) 

700 REM ======== 

710 IF s%<9 ENDPROC ELSE ptr%=DD«+by tes^*s* 

720 IF mode%<>ll:IF input'%<0 Jnput^=127-input5t 
730 IF mode^OllrlF output%<0 output^=127-output% 

740 IF )ump%<0 )ump%=255 

750 ?ptr*=rate*: ptr«?l =mode^! ptr*'>2= i nput%; ptr«?3 = output«: 

ptr%?4=wa i ptr*'?5= j ump* 

760 ptr?e=ptr«+6:FORM«=0TON«;'7ptr«=5a«(M«>MOD256: 

ptr%?l=sa%<M%)DIV256:ptr%=ptr«+2;NEXT 
770 ENDPROC 
780 : 

790 DEF PROCl imit(M«> 

800 REM ========= 

810 LOCAL z^,h%:z%=0;h«=H«*2. 001-1 

820 IF M*=0 h«=l 

830 IF M«=40RM%=5 PROCiimpy 

840 IF sa%(M*)<z* sa*(M«> =z*: i sa*<M*> =0 : ENDPROC 

850 IF sa«<M«>>h* sa^K<M%) =h*: i sa«<M%) =0 : ENDPROC 

860 ENDPROC 

870 DEF PROCiimpy 

880 IF sa*<5>>450 ENDPROC 

890 IF sa%(4)<200:IF sa%( 5 > -sa*<4 ><250 sa«(M%;>=sa«<9-M%> + 250 : 


isa«(M«>=0; ENDPROC 



900 IF sa^(4)^ = 200: IF sa^f 5 ) 4-sa^M ><6 50 sa«fM%) =650-s3^( 9-M5K) ; 

isa%(M%)=0:ENOPROC 
910 ENDPROC 
920 : 

950 DEF PROCscaleCm^, 

940 REM ========= 

950 LOCAL i : FOR 1 %;=m5KTOn% 

960 LSA«( i«>=lsa«( i%>*span< i«)+intcpt«( i*> : 

SA1K( i'«>=sa%:( i%>*span( i«> + 1 ntcpt%< i%) 

970 NEXT; ENDPROC 
980 : 

990 DEF PROCdescale 
1000 REM =========== 

1010 FORM«=lTON*:sa*<N«:> = <SA«(M%>-intcpt%<M^) > /span<M%) +0 . 4 :NEXT 
1020 ENDPROC 
1030 : 

1040 DEF FNverify 
1050 REM ======== 

1060 IF S%<0 OR S*>E* = FALSE 

1070 IF mode*=10ANDNOTl% THEN=FALSE ELSE IF mode%=l OR mode«=ll 
OR mode%>5 = TRUE 

1080 3=0:FORM«=lTON«:a=J+sa%(M%> :NEXT 

1090 IF rateSfe>0 AND rate%<10 AND mode«>0 AND mode«<7 AND J>=0 
AND 3<=U%*H%*Z THEN = TRUE ELSE = FALSE 


1100 : 

1110 ; 

1120 DEF PROCstep 
1150 REM ======== 

1140 PROCwatchdog 

1150 good=FNver i f y : IF NOTgood PROCfau 1 t ; ENDPROC 
1160 IF stop COLOURfl*: PRINT’ •" EMERGENCY STOP pressed" 
COLOURwh^ : VOU7 , 7 , 7, 7, 7, 7, 7, 7: ENDPROC 
1170 IFmode%>l AND mode%<6 PROCpath 
1180 lastS*=S«;S*=S*+l :PROCpeek<S*) 

1190 ENDPROC 
1200 : 

1210 DEF PROCpath 
1220 REM ======== 


1250 

1240 

1250 

1260 

1270 

1280 

1290 

1500 

1510 

1520 

1550 

1540 

1350 

1560 


LOCAL a«.in«,s* 

PROCscale<l ,N«> :LSA«<0>=lsa%(0) 

CALL CALCISA,sa*(l ) . lsa«<l > , isa«<l ) .WSPA%(0> 

PROCwbus< keypad, <outa*AND224>+16) ; hkey%=0 
IF rate%>4;IF WSPA%<0>>60 THEN PROCstatus< 5 > 

CALL SAMOVE, rat e%, modest hkey%, ipmska^, ipmskb%, ipres%, 
outb%, SA%(0 > ,LSA%< 0 > , i sa%< 1 > ;PROCstatus(0> 

PROCg r i p ( s b .% ( 0 ) ) 

FORM*=0TON%; 1 sa«(M*> =sa*<M^) :NEXT : lastS%=S« 

ENDPROC 


DEF PROCout(a*,out*> 

REM ======= 

local o«, v%. j%! j*=ABS<out«> 
o%=0:REPEATo%=o%+ 2''( j*MOD10-l) 


j%= j%DIV10tUNTILj%=0 



1570 IF out%<0 THEN o%=o% EOR 2>5 : out%<a%) =out%(a%> AND o* ELSE 
out%<a*) =out%<a^) DR o% 

1580 IF a%=0 outb%=(outb%AND240>+out%(a^) : 

PROCwbus<procout%<a%) .outb«) ; ENDPROC 
1590 PROCwbus<procout*<a^) ,out%(a%>> .-ENDPROC 
1400 : 

1410 DEF PROCgrip(g) 

1420 REM ======== 

1450 outa*=128*g+<outa%AND127) ; PROCwbus <gr i pout , outa%) rENDPROC 
1440 : 

14.50 DEF PROCwatchdog 
1460 REM ============ 

1 470 PROCwbus (&7F . 0 ) : ENDPROC 
1480 : 

1490 DEF PROCstatus(state> 

1500 REM ========== 

1510 IF state>0 state=state+5 

1520 outb%=(outb^ ANDl 5 > +state*l 6 : PROCwbus ( portb, outb%) .-ENDPROC 
1550 : 

1540 DEF FNyes 
1550 REM ===== 

1560 *FX21 ,0 

1570 IF GET$="N"THEN PRINT"NO” * : =FALSE ELSE PR INT"YES" ’ : =TRUE 
1580 : 

1590 DEF PROCwhere 
1600 REM ========= 

1610 F0RI%=lT05:PR0Cstatus<2> :CALL REPORTEPP . outb% . WSPA«< 1 > , 
WSPB^d ) ,WSPC*(1> :PROCstatus<0> :NEXT 
1620 FOR M%=1T0N%:SA%<M%>=WSPB%<M^) :NEXT:PROCdescale: 

FOR M%=lTON%:PROCl imit(M%> ; lsa^(M«>=sa^<M%) :NEXT 
1650 ENDPROC 
1640 : 

1650 DEF PROCclearall 
1660 REM ============ 

1670 LOCAL I,J 

1680 PRINT"Clearing DATA AREA, please wait."* 

1690 I=DD*-410:E«=0:->I=85: I '>1 = 170: I'>2=bytes%: 

I'?5=T*; I !4 = 0: 118 = 0: I ! 12 = 0 

1700 FOR S%=lTOTS«:ptr%=DD*+bytes%»S*:PRINTS«; VDUll : 

FOR I*=0TObyte5%:ptr%7i^=0 ;NEXT :NEXT :VDU11 :S«=0 
1710 ENDPROC 
1720 : 

1750 DEF PROCpark 
1740 REM ======== 

1750 PROCwhere 

1760 rate%=7;mode%=2 : input*= 0 :output%=0 :wai ^*=0 : jump«=0 
1770 PROCgrip<0> zREPEAT PROCcheckmc : UNTIL NOTstop 

1780 T= 0 :CLS;PRINT:PROCi ;PRINT"Check that it is" ; ;PROCn:PRINT’ ’ " 
PROCi :PRINT"SAFE to MOVE the ROBOT” PROCn -. PRINT ; PRINT 
1790 PRINT"’First PARK the ROBOT. Press P"’ 

1800 REPEAT .-UNTIL GET$ = "P" 

1810 REPEAT PROCcheckmc .-UNTIL NOTstop: CLS 
1820 PRINT’ "Moving to PARK position”’ 



18 50 sa%<l ) = ?00:sa%(2>=8>8:sa«(5>=^60:sa%(4>=999.•sa*<5)=500.■ 
sa^( 6 > =0 : Sa^< 0 > =0 
1840 PROCpoke<0) : PROCstep : ENDPROC 
1850 : 

I860 DEF PROCcheckseq 
1870 REM ============ 

1880 DD%=<HIMEM+&50)AND&FFF0;BB*=AA*-bytes«-l : 

TS*=<BB*-DD%)/bytes«: IF TS%>250 TS%=250 
1890 IF T*>TS% OR T%=0 THEN T«=TS« ELSE TS%=T% 

1900 IF c% CC^=DD%+(T%+2>*bytes^: IF CC«>BB«-N«*2 c%=FALSE 
1910 I=DD%-«cl0:IF ■?I=85 AND I’>1 = 170 AND I'>2=bytes% THEN T%=I->5; 

E%=I'>4;seq=I'?5 + 256*( I'?6) : Z«= I ! 7 : tool%= I ■>! 1 : ENDPROC 
1920 ?I=85: I’?l = 170; IF •?I<>85 OR I'>1<>170 COLOUR f 1 IK : PR I NT ’ 

"CAN NOT ACCESS STORED-SEQUENCE MEMORY” ’ :COLOURwh*:PROCfata I 
1950 PRINT’"Clear data area <Y/N) ";:IF FNyes THEN PROCc learal 1 : 
ENDPROC 

1940 PRINT”Are you SURE" PRINT” "that data area is NOT 

corrupted-?! " ’ "<Y/N) ";:IF FNyes ENOPROC ELSE PROCciearall 
1950 ENDPROC 
I960 ; 

1970 DEF PROCcheckmc 
1980 REM =========== 

1990 LOCAL k 

2000 k=FNrbus<portb)ANO 6 

2010 IF k=6 OR (<k=0)ANDgood> COLOURf l*:PRINT’ ” CONTROLLER 
STATUS INVALID" :COLOURwh%! PROCfatal : ENDPROC 
2020 IF k 02 COLOURf I«:PRINT'" CONTROLLER NOT IN AUTO”: 

V0U7.7,7,7.7:REPEAT PROCwatchdog:k=<FNrbus(portb> >AND 2: 
UNTIL k ; VDUl 5,11 :PRINTTAB< 100 > : VDUl 5,11,11.11; PROCwhere 
2050 k=<FNrbus<portb> )AND8: IF k AND NOTstop THEN stop=TRUE: 
COLOURf 1%:PRINT”" EMERGENCY STOP pressed" :COLOURwh%: 

VDU7 . 7 , 7 , 7 , 7 , 1 1 ;ENDPROC ELSE IF k=0 AND stop THEN stop= 
FALSE:PRINT" EMERGENCY STOP re leased’” : PROCwhere 
2040 ENDPROC 
2050 : 

2060 DEF PROCfatal 
2070 REM ========= 

2080 *FX 214.254 

2090 COLOURf 1%:PRINT”TAB<5)”! !! FATAL ERROR !!!"’:PROCn 
2100 VDU7:TIME=0: REPEAT UNTILTIME>6000 ; RUN 
2110 ENDPROC 
2120 : 

2150 DEF PROCptrs 
2140 REM ======== 

2150 I%=DD«-&10: I5K?5 = T%: I!K?4=E%; I*?5 = seq MOD256; 

I%'?6=seq OIV256; 1%17=Z%: I«?ll=tooi% 

2160 ENDPROC 
2170 ; 

2180 DEF PROCset 
2190 REM ======= 

2200 FORM!K=0TON%; isa^(M%>=0 : NEXT: ENDPROC 
2210 ; 



2220 DEF PROCinitial 
2250 REM =========== 

2240 b%=3c500;REM Base Address of 8255 interface 
2250 PUT b%+5.158:PUT b%+5.5:REM initialise interface 
2260 f 1^= 5 1 : wh^=7 ; REM screen colours 
2270 *FX15 

2280 T«=FNf lag<0) : l%=( rNT(VAL( I$> > = 5> 

2290 c*=FNf lagd ) : o«=FNf lag( 2 > : x%=FALSE : y%=FALSE ; t«=FNf lag< 5 > : 
u«=FNf lag(6> 

2500 dr 1 ve=FALSE ; run=FALSE : ed 1 1 =FALSE : s top=FALSE : good=FALSE 
2510 S%=0: lastS%=0:out%=0:outa%=0;outb%=0:bytes%=<N%+l )*2+6 
2520 LK%=0 : seq=0 : seq$=”” :H*=500 ; pt r=0 : 0$= "P" 

2550 kdi sp*=0;wai*=100: xyz?fe=0 
2540 DIM span < 6 > , 1 ntcpt%< 6 ) 

2550 RESTORE 2550:READ IS: IF IS>"" PRINT”Serial No. "IS 
2560 FORM%=1TON%;READ span<M^> :NEXT:F0RM%=1T0N^; 

READ intcpt%<M«> .-NEXT 

2570 DIM isa^<7> .sa^(15> , lsa%<7> ,procin«(2) .procout%(2) , 
out%<5> .err*<15> ,SPD%< 15) 

2580 access$=" ” : code99S=”0184” 

2590 : 

2400 REM MA-Interface addresses 

2410 setpt 1=0: setpth=&8:err=410;posl=&20 :posh=ac28 :pwr=&50 

2420 porta=&81 : portb=3c80 

24 50 pgain=a:58 ; igai n=3c40 :dgain=ac48 

2440 keypad=porta:gripout=porta 

2450 procin%<0>=porta: procout%< 0 > =portb 

2460 proc in%C 1 ) =482 ; procout%< 1 > =482 : proc t n%( 2 ) =48 5 : procout%< 2 > =485 
2470 FORI%=0TO5:out%< I*>=0:NEXT 
2480 : 

2490 DIM kbmd* 12.kbid^ 12,kpn^ 20 

2500 '?kbmd%=0;kbfnd%! 1=404050201 :kbmd%! 5=40504060 5 : kbmd%» 9=4050201 06 
2510 '?kbid%=0:kbid5fe! 1=400020202 : kb id^! 5=402020000: kb I d«l 9=400000002 
2520 kpnl^! l=40704010A:kpn*»5=40805020B:kpn*!9=40906050C; 

kpn^l 15=41 00F0E0D:kpn1^! 17=414121115 
2550 : 

2540 DATA ”” 

2550 DATA 5.25.5.25,5.25.2.80.2.80,2.80 
2560 DATA 425, 425, 425, 648, 648, 648 
2570 ENDPROC 
2580 : 

2590 DEF FNflagd*) 

2600 REM ====== 

2610 IF 1% THEN =(FF*?< I*+4>=255 > ELSE =FF*74 
2620 : 

2650 DEF PROCi :COLOUR0.-COLOUR128+wh%.-PRINT” ";:ENDPROC 
2640 REM ===== 

2650 DEF PROCn:PRINT" :COLOURwh% : COLOUR 128 : ENDPROC 

2660 REM ===== 

2670 ; 

2680 DEF PROCmcode 
2690 REM ========= 

2700 DIM WSPAiK(7) ,WSPB%<7> .WSPCt«<7> .SA%(7> .LSA«<7> 



2710 ipadd%=0 : ipmska%=0; ipmskb%=0: i pres*=0 : pt r^=0 
2720 lbyte%=0:hbyte^=0;dri vem%=0 : hkey%=0 
2750 REM 

2740 OSCLI”LOAD MA2-"+STR$<N«>+” "+STR$~(AA%> 

2750 SAMOVE = AA%+&95:SETLIMIT=AA?fe+&2Cl :DRIVESA=AA*+&:2DA: 

LEADSA=AA%-»-A5A8 :REPORTEPP=AA«+3t3FF;REPORTPID=AA«+&496; 

SETP I D= AA«+3c5 1 D : KE YPAD= AA^+&5 AC ; CALC I SA= AA%+&62 5 : 
C0NTPATH=AA%+&6AC 

2760 FOR M«=1T0N«:WSPA*(M%>=INT( <H%*2. 001-1 ) > *span<M«> F i ntcpt*<M%) 
WSPB%(M«)=intcpt«<M«) ;NEXT 
2770 CALL SETLIMIT .WSPA«< 1 > ,WSPB«< 1 > 

2780 rata%=0:mode%:=0:FORr=0TO7!WSPA%< I ) =0 : WSPB%< I > =0 : 

WSPC«< I >=0:NEXT 
2790 ENOPROC 
2800 : 

2810 DEF PROCcontpath 
2820 REM ============ 

28 30 PROCscaied ,N*> ; PROCwbus (keypad . <outa'%AND224)+16) : 

hkey%=0 : PRQCstatus < 5 > 

2840 WSPC*(1 )=CC*:WSPC«(2)=CC%+Z«*2*N« 

2850 CALL CONTPATH , rate*, mode*, hkey%, out b«, LSA«(0 > .WSPC*< 1 > 

2860 PROCstatus(0) : lastS*=S*: PROCdesca le : FORM*=0TON*: 

lsa*(M*>=sa*(M*> :NEXT 
2870 ENOPROC 
2880 : 

2890 DEF PROCgettele 
2900 REM =============== 

2910 FOR CH*=0 TO 7 
2920 BASE*=&3E0 
2950 PUT BASE*+10,CH* 

2940 PUT BASE*+11,1 
2950 HI=GET(BASE*+5> 

2960 IF HI >=16 THEN GOTO 2950 
2970 LO=GET(BASE*+4) 

2980 V=(HI*256+LO-2048>*10/4096 
2990 IF CH*=1 sa*<l>=vjl+p]H<-V 
3000 IF CH*=7 sa*<2>=vj2+pj2*V 
5010 IF CH*=3 sa*<3)=vj3+Pj5*V 
3020 IF CH*=0 AND V<1 sa*(0>=0 
5030 IF CH*=0 AND V>1 sa*<0>=l 
>040 IF CH*=4 sa*(4>=v j4Fpj4*V 
5050 IF CH*=5 sa*<5)=v j5+pj5*V 
5060 IF sa*(5)<250 sa*(5)=260 
5070 IF sa*<5)>750 sa*(5>=750 
5080 IF CH*=6 sa*<6)=vj6+pj6*V 
5090 NEXT 

5100 FOR M*=0 TO N*!PR0CI imit<M*> iNEXT 
5110 Q*=0 
5120 REPEAT 
5150 Q*=Q*+1 

5140 UNTIL a *>6 OR (ABS(sa*<Q*>-err*(Q*> > >50) 

5150 IF Q*>6 GOTO 5170 

5160 FOR Q*=l TO 6 : err*(Q*> =sa*(Q*> : NEXT : ENOPROC 
5170 FOR Q*=i TO 6 : sa*(Q*> =err*<Q*> : NEXT: ENOPROC 



